perm filename CALIB.NRL[V,VDS] blob sn#299721 filedate 1976-09-07 generic text, type T, neo UTF8
	NAVAL RESEARCH LABORATORY - MODEL M.I.T. ARM  CALIBRATION
	

KINEMATIC ARM CONSTANTS:  01AUG76

	S1 = 10.770 inches
	A2 =  8.000 inches
	S2+S3= 4.67 inches
	S4 =  8.000 inches
	S6 =  6.000 inches	To center of fingers(.35 in from tip)

	Shoulder assumed to be located at [0,0,S1]


TRANSFER FUNCTIONS FOR THE "ARM" PROGRAM


	Scaled Joint Angle ← 2↑(-12)*(ADC reading)*SCALE + OFFSET

	DAC value ← 2↑(K2)*(Scaled Joint Angle - BOFFST)*BSCALE


The constants for these equations can be computed from the calibration
data as follows:


	SCALE  ← (2↑27/K1)*(change in degrees/change in ADC reading)

	OFFSET ← (2↑15/K1)*(angle in degrees) 
			- 2↑(-12)*( ADC reading ) * SCALE

	BSCALE ← (2↑(K3)/SCALE)*DSCALE

	BOFFST ← OFFSET + 2↑(-12)*SCALE*DOFFST

   where

	DSCALE ← (change DAC output)/(change in pot reading)

	DOFFST ← pot reading - ( DAC value )/DSCALE

   for  joints 1-6:  K1 = 360, K2 = -17, K3 = 29
        hand:	     K1 =  32, K2 = -15, K3 = 27
JOINT #1:

Pot Calibration: 01AUG76.

	Set Point	 A/D		Partial Differences

	-90.0		 738. 		1031.
	  0.0		 1769 		1043.
	+90.0		 2812.

	SCALE:		32357.
	OFFSET:		-14022.

Dac to Pot Calibration: 28AUG76

	Dac Output	Pot Reading	Partial Differences

	-1000.		 1049.		 
	- 500.		 1552.		 503.
	    0.		 2054.		 502.
	  500.		 2557.		 503.
	 1000.		 3060.		 503.

	BSCALE:		16501.
	BOFFST:		 2208.
JOINT #2: 

Pot Calibration: 01AUG76

	Set Point	 A/D		Partial Differences

	   0.0 DEG	 3137.		1076.
        - 90.0		 2061.		1029.
	-180.0		 1032.	

	SCALE:		31881.
	OFFSET:		-24416.

Dac to Pot Calibration: 28AUG76

	Dac Output	Pot Reading	Partial Differences

	-1000.		 1064.		 
	- 500.		 1560.		 496.
	    0.		 2055.		 495.
	 1000.		 3047.		 992.

	BSCALE:		16984.
	BOFFST:		-8417.
JOINT #3:  

Pot Calibration: 01AUG76

	Set Point	 A/D		Partial Differences

	 0.0DEG		3111		1041.
	 90.0		2070		1056.
	180.0		1014

	SCALE:		-32002.
	OFFSET:		24306.

Dac to Pot Calibration: 28AUG76

	Dac Output	Pot Reading	Partial Differences

	-1000.		 1058.		
	    0.		 2054.		996.
	  500.		 2552.		498.
	 1000.		 3049.		497.

	BSCALE:		-16852.
	BOFFST:		  8262.
JOINT #4: 

Pot Calibration: 01AUG76

	Set Point	 A/D		Partial Differences

	-180.0		981		1108.
	-90.0		2089		1025.
	 0.0		3114
	
	SCALE:		31462.
	OFFSET:		-23919.

Dac to Pot Calibration: 28AUG76

	Dac Outpqt	Pot Reading	Partial Differences

	-1000.		 1101.		
	- 500.		 1579.		478.
	    0.		 2056.		477.
	 1000.		 3011.		955.

	BSCALE:		17868.
	BOFFST:		-8127.
JOINT #5: 

Pot Calibration: 01AUG76

	Set Point	 A/D		Partial Differences

	- 90.0		 635.		1458.
	   0.0		2093.		1441.
	  90.0		3534.
	
	SCALE:		23149.
	OFFSET:		-117_1.¬

@ac to Pot Calibration: 28AUG76

	Dac Output	Pot Reading	Partial Differences

	-1000.		 1049.		
	- 500.		 1551.↓	502.
	    0.		 2053.		502.
	 1000.		 3058.		1005.

	BSCALE:		23088.
	BOFFST:		- 175.
JOINT #6:  

Pot Calibration: 01AUG76

	Set Point	 A/D		Partial Differences

	-180.0		 3793.		1084.
	- 90.0		 2709		1047.
	   0.0		 1662.		1059.
	  90.0	 	  603.

	SCALE:		-31556.
	OFFSET:	 	12838.

Dac to Pot Calibration: 28AUG76

	Dac Output	Pot Reading	Partial Differences

	-1000.		 1055.		
	    0.		 2053.		998.
	  500.		 2553.		500.
	 1000.		 3052.		499.

	BSCALE:		-17039.
	BOFFST:		- 2982.
HAND:

Pot Calibration: 01AUG76

	Set Point	 A/D		Partial Differences

	   0.25inches	 1710.		321.
	   0.75		 2031.		384.
	   1.25		 2415.		373.
	   1.75		 2788.

	SCALE:		5836.
	OFFSET:	 	-2181.

Dac to Pot Calibration: 28AUG76

	Dac Output	Pot Reading	Partial Differences

	- 300.		 1755.		
	    0.		 2056.		301.
	  600.		 2661.          605.

	BSCALE:		22846.
	BOFFST:		  750.
JOINT STOP LIMITS:  17AUG76


      Joint	Mechanical	Software  	Mechanical	Software
		Minimum		Minimum		Maximum		Maximum

	1	-147.63		-135.0 		190.30		185.0
	2	-259.53		-245.0 		 74.06		 60.0
	3	 -63.52		 -55.0 		225.57		215.0 
	4	-247.35		-235.0		 70.38		 60.0
	5	-111.86		-107.0		113.90		107.0
	6	-179.91		-170.0		120.05 		110.0
α      hand	-  0.03		  -0.03		  1.933		  1.9